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(54) Apparatus and method for controlling a construction machine 

(57) An apparatus and method for controlling a con- 
struction machine. 

The finishing precision and uniformity of hardness 
of a surface finished by the construction machine, such 
a back-hoe, is improved by modifying the targets of a 
position-tracking control system based on work load 
applied to the end effector (15) of the construction 
machine. For example, a compaction force of a surface, 
contoured by a position-tracking back-hoe, can be 
made more uniform. This is accomplished by adjusting 
actuator targets, otherwise controlled on the basis of 
positional and speed constraints, in response to a 
detected work load acting on the end effector (15). To 
detect work load, a hydraulic fluid pressure signal can 
be applied to a computer which generates target posi- 
tion and speed commands to the feedback system. The 
control circuit may be arranged to hold work load con- 
stant (generating a constant compaction force for exam- 
ple) or, in response to a priority signal, the circuit can 
give a selected weight to both the positional constraints 
and the work load constraints. Another benefit of alter- 
ing position-tracking in response to work load is 
improved coordination of actuators (14). For example, 
the gain of feedback and feedforward signals of a posi- 
tion-tracking control system can be increased when a 
detected load is heavy, increasing response, and atten- 
uated when the load is light. 




FIG. I 
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Description 

The present invention relates to method and appa- 
ratus for controlling construction machinery, for exam- 
ple, hydraulic shovels and back hoes. 

Referring to Fig. 6 a back-hoe has a revolving upper 
structure 12 mounted on a lower structure 1. A working 
portion, in this case a back-hoe 13, is connected to 
revolving upper structure 12. 

Back-hoe 13 has a boom 15bm and a stick 15st 
linking boom l5Bm with a bucket 15bk. Boom 15bm piv- 
ots around its base end where it attaches to upper- 
structure 12. Boom 15bm is forced by a boom cylinder 
1 4bm. Stick 1 5st pivots from a distal end of boom 1 5bm, 
forced by a stick cylinder 14st. Bucket 15bk pivots on a 
distal end of stick 1 5st and is forced by a bucket cylinder 
14bk. 

Pivot angles of boom 15bm, stick 15st, and bucket 
15bk are each detected by resolvers or other appropri- 
ate angle sensors 16bm, 16st, 16bk. Signals represent- 
ing relative angles are input into a controller 21 through 
feedback loops 1 8bm, 1 8st, 1 8bk and applied to a signal 
transformer 17 on revolving upper structure 12. Control- 
ler 21 includes a microcomputer. 

A display switch panel 22 serves as a human-inter- 
face. Display switch panel 22 is connected to a control- 
ler 21. Inputs applied to controller 21 include a control 
switch 23, an engine pump controller 24, a pressure 
sensor 25, and a inclination sensor 26. A control switch 
23 on an operating lever is used by an operator to initi- 
ate automatic control or control the engine speed. 
Engine pump controller 24 controls a engine (not 
shown) and a pump based on the engine speed 
detected by an engine speed sensor 24a. Pressure sen- 
sor 25 detects the position of the operating lever. Incli- 
nation sensor 26 detects the angle of inclination of the 
vehicle. A solenoid valve 27 is connected to a output ter- 
minal of controller 21 . 

Controller 21 is has a closed-loop control compen- 
sator for controlling boom cylinder I4bm, stick cylinder 
14st, and bucket cylinder I4bk. With the closed-loop 
control compensator, controller 21 forms a position-trac- 
ing feedback control system. The system constantly 
monitors operating strokes of the respective cylinders. It 
performs feedback control of the actual positions and 
speeds of boom 15bm, stick 15st, and bucket 15bk by 
comparing command signals from the operating lever 
with signals representing rotation angles of boom 15bm, 
stick 15st, and bucket 15bk, fed back from angle sen- 
sors 16bm, 16st, 16bk. For the construction machine to 
perform operations like horizontal leveling or slope fin- 
ishing, controller 21 electrically controls proportional 
control solenoid valves (not shown) indirectly, using sig- 
nals calculated by the closed-loop control compensator 
to eliminate the difference (error) between the feedback 
signals (from angle sensors 16bm, 16st, 16bk) and the 
signals representing target values computed by the 
microcomputer. Boom cylinder 14bm, stick cylinder 14st 
and bucket cylinder 14bk are extended or contracted by 



means of pilot control of control valves (not shown) 
using pilot pressure generated by the proportional con- 
trol solenoid valves. Controller 21 is thus capable of 
automatically maintaining the bucket at a constant angle 
s or the tip of the bucket teeth in a constant plane during 
such operation as horizontal leveling or slope finishing. 

The position of the bucket is controlled automati- 
cally, using a microcomputer, to maintain the bucket 
angle and constrain to specified loci the tip of the bucket 
w teeth during horizontal leveling or slope finishing. In a 
conventional hydraulic excavator, typically, a closed- 
loop control is used in which signals output by angle 
sensors 16bm, 16st, 16bk of the respective articulating 
elements of the working tool (back-hoe, in this case) are 
15 fed back to controller 21 . Controller 21 outputs final con- 
trol signals to minimize the deviation of cylinders 14bm, 
14st, 14bk (which control the positions of boom 15bm, 
stick 15st, and bucket 15bk) from the computed con- 
straints based on the bucket positional constraints. 
20 According to the control mechanism of the prior art, 
however, the work load of bucket 15bk (the loads bom 
by cylinders 14bm, 14st, 14bk) is regarded merely as a 
disturbance. Factors such as compaction force of the 
surface created by excavation are excluded not subjects 
25 of the control system. That is, there are no preset target 
values for such load-related variables. As a result, not 
only is there no guarantee of uniform hardness of the 
finished surface, but there is also the possibility of a 
decrease in finishing precision, caused by fluctuation in 
30 digging force. In addition, the operating efficiency of the 
tool may deteriorate because of a decrease in cylinder 
speed when excessive work load is applied. 

When the excavation work load of bucket 15bk 
increases during the excavation, in other words when 
35 disturbance increases in the control system, work load 
of boom cylinder 14bm increases as compared to when 
the digging work load is small. This delays follow-up 
movement of the boom 15bm. Thus, the actual surface 
formed by excavation can deviate from the target sur- 
40 face defined by the positional constraints on the tool 
(bucket, in this case). In other words, the various articu- 
lating members can fall out of synch since each cylinder 
may experience a different change in load. When a 
delay occurs during horizontal leveling or ground finish- 
ing, poor finishing precision is the result. 

To counter this problem, an integrating factor may 
be added to the closed-loop compensator in order to 
reduce the difference between a target position and the 
actual position of boom cylinder 14bm. However, merely 
tossing in an integral compensation term presents prob- 
lems. For example, an a large integral term can slow fol- 
low-up movement, which can also cause the articulating 
members to fall out of synch due to sluggish response 
to rapid changes in work load. In addition, control sys- 
tem instability may result, depending on the positions of 
the linkages. For these reasons, an integrating factor is 
not permitted to have a large gain. Therefore, it is diffi- 
cult to make use of the effect of the integrating factor to 
the extent desired. 
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An object of the present invention is to provide a 
control method and apparatus for a construction 
machine which is capable of improving the precision 
and the uniformity of hardness of the finished surface. 

Another object of the present invention is to auto- s 
matically controlling a construction machine by tracking 
positions of as well as load of the moving elements of a 
working tool an-or derivatives of such loads to deter- 
mine such variables as digging force and compaction 
force. 10 

Another object of the invention is to improve track- 
ing and coordination of movement of movable elements 
of a construction tool, thereby ensuring a specified fin- 
ishing precision even when digging work load varies 
during horizontal leveling, ground finishing, or any other is 
operation requiring controlled and coordinated move- 
ment of a tool. 

Briefly, the finishing precision and uniformity of 
hardness of a surface finished by a construction 
machine, such as back-hoe, is improved by modifying 20 
the targets of a position-tracking control system based 
on work-load applied to the end effector of the construc- 
tion machine. For example, compaction force of a sur- 
face, contoured by a position-tracking back-hoe, can be 
made more uniform. This is accomplished by adjusting 25 
actuator targets, otherwise controlled on the basis of 
positional and speed constraints, in response to a 
detected work load acting on the end effector. To detect 
work load, a hydraulic fluid pressure signal can be 
applied to a computer which generates target position 30 
and speed commands to the feedback system. The con- 
trol circuit may be arranged to hold work load constant 
(generating a constant compaction force for example) 
or, in response to a priority signal, the circuit can give a 
selected weight to both the positional constraints and 35 
the work load constraints. Another benefit of altering 
position-tracking in response to work load is improved 
coordination of actuators. For example, the gain of feed- 
back and feedforward signals of a position-tracking con- 
trol system can be increased when a detected load is <o 
heavy, increasing response, and attenuated when the 
load is light. 

The present invention implements a control method 
for controlling movement of the end effector of a con- 
struction machine and particularly to such machines 45 
that employ a feedback control system to control 
respective positions of the end effector actuating cylin- 
ders. In the present invention, the work load of the end 
effector is detected by detecting cylinder work load 
pressure applied to the end effector actuating cylinder so 
or end effector actuating cylinders. Target values for the 
feedback control system that performs position tracking 
are determined responsively to the work load feedback 
signals. According to this method, the work load of the 
end effector, for example compaction force, is detected ss 
by measuring cylinder work load pressure, and the posi- 
tion of the end effector actuating cylinder is controlled to 
obtain a desired compaction force and the like. For 
example, the compaction force is reduced by raising the 



bucket or increased by lowering the bucket responsively 
to the detected work load. The position-tracking feed- 
back control system thus performs feedback control to 
maintain the work load of the end effector, such as dig- 
ging force and compaction force, by means of detecting 
cylinder work load pressure applied to the end effector 
actuating cylinders. Thus, the invention is capable of 
improving finishing precision by using a existing feed- 
back control system for position tracking innate to the 
machine and also capable of regulating hardness of the 
finished surface by controlling compaction force and/or 
other work loads of the end effector. This is accom- 
plished by using an end effector work load feedback 
control system. 

The invention also implements a control method for 
the end effector of a construction machine wherein the 
relative priority of position-tracking control versus work 
load control can be selected. Thus, if priority is given to 
the end effector work load control, the tool is controlled 
to maintain a desired compaction force or other variable 
derived from the work load. If priority is given to the end 
effector position-tracking control, the tool is controlled to 
constrain movement to a desired locus of points. Bal- 
ancing priority between position-tracking control and 
end effector work load control has various merits. For 
example, the higher the degree of priority on end effec- 
tor work load control, the more uniform is the hardness 
of a finished surface. Furthermore, should overload 
occur, decrease in operating efficiency can be mini- 
mized by giving priority to end effector work load control 
over position tracking control, thereby preventing reduc- 
tion of cylinder speed. 

The invention also implements a control method for 
a construction machine, and particularly to a control 
method in which the derivative variable made the target 
of control is compaction force. More particularly, in this 
method, the equipment compaction force generated by 
the equipment's end effector is controlled by controlling 
the vertical position of the end effector. In this method, 
the compaction force, corresponding to the load on the 
end effector, is feedback controlled to remain constant 
as the position-tracking feedback control system con- 
trols the vertical position of Ihe equipment. According to 
this feature of the invention, by adjusting targets of the 
position-tracking feedback control system that vertically 
controls the position of the end effector responsively, it 
is possible to implement feedback control of compaction 
force in a position-tracking control system. 

The invention also implements an apparatus for 
controlling the end effector of a construction machine 
that employs a feedback control system to control 
respective positions of the end effector actuating cylin- 
ders. The control apparatus includes a work load pres- 
sure detector to detect work load of the end effector by 
detecting pressures of the end effector actuating cylin- 
ders. In also includes an end effector work load setting 
device which determines target values for the position- 
tracking feedback control system by comparing with 
feedback signals generated from end effector work 
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load. In this way, the height of the end effector is auto- 
matically adjusted so that the end effector work load 
detected by the work load pressure detector corre- 
sponds to a preset value input by a user through a vari- 
able control. The automatic adjustment thus, for 5 
example in the case of compaction force, raises the end 
effector to reduce the compaction force or lowers the 
end effector to increase the compaction force. The posi- 
tion-tracking feedback control system thus performs 
feedback control to maintain the end effector work load 10 
at a set value by using the work load pressure detector 
to detect work load of the end effector. Target values for 
the work load of the effector work load are adjusted 
using a load-setting control. According to an embodi- 
ment of the invention, the control is capable of ensuring 75 
a specified finishing precision by using a existing posi- 
tion-tracking feedback control system innate to the 
machine. In addition, the invention can provide for uni- 
form hardness of a finished surface by controlling com- 
paction force and other work loads of the end effector. 2 o 

The invention also implements an apparatus for 
controlling the end effector of a construction machine 
capable of accepting the input of a target value for 
equipment work load and for accepting input of a varia- 
ble priority between work load and position tracking. In 25 
cases where priority is given by the priority setting 
device to the end effector work load control, a desired 
end effector work load is maintained constant. To 
improve surface finish, a higher priority can be given to 
position tracking. The latter is accomplished, according 30 
to ah embodiment of the invention, by causing the prior- 
ity setting device to reduce the degree of priority to end 
effector work load control, thereby giving higher priority 
to position-tracking control. By using the priority setting 
device, it is possible to choose the mode of control 35 
according to the nature of work between the control 
mode that calls for giving priority to end effector work 
load control and the other mode that calls for giving pri- 
ority to position-tracking control. Thus, the invention is 
capable of coping with different types of operations: 40 
ones that places stress on uniformity of digging force or 
compaction force and others that place priority on preci- 
sion in position tracking, such as operations requiring a 
precise surface finish or slope gradient. 

The invention also implements an apparatus for 45 
controlling the end effector of a construction machine 
that employs a feedback control system to control 
respective positions of the end effector actuating cylin- 
ders, the apparatus including a feedforward loop posi- 
tioned in the position-tracking feedback control system, so 
and a feedforward gain adjusting means for adjusting 
the gain of the feedforward loop in accordance with dig- 
ging work load, wherein the ability of position tracking 
with respect to digging work load is improved by 
increasing or reducing the gain of feedforward signals 55 
according to digging work load. As a feedforward loop is 
thus added to the feedback control system that controls 
positions of the end effector actuating cylinders, the 
invention improves efficiency of position tracking of the 



end effector actuating cylinders. Furthermore, by using 
a gain adjusting means to adjust the gain of the afore- 
mentioned feedforward loop according to digging work 
load, deviation of the actual position of a cylinder from 
its target position is reduced. Therefore, precision of 
position tracking of the end effector actuating cylinders, 
irrespective of digging work load, is improved. A speci- 
fied finishing precision is ensured even if digging work 
load increases during ground preparation work, such as 
horizontal leveling or slope finishing; In cases where the 
digging work load is small, the gain is automatically low- 
ered, thereby ensuring stability of the control system. 

The invention also inplements an apparatus for 
controlling the end effector of a construction machine by 
adjusting a feedforward gain responsively to pressure 
sensors installed to detect cylinder work load pressure 
of the end effector actuating cylinder(s). Gain is 
adjusted according to a look-up table stored in memory. 
The look-up table defines a relationship between the 
cylinder work load pressure detected by the pressure 
sensors and the gain. Cylinder work load pressure 
applied to a end effector is detected and the cylinder 
actuated responsively to the pressure detected by 
retrieving a desired gain that corresponds to the 
detected cylinder work load pressure from a memory. 
The gain of the feedforward loop is then automatically 
adjusted to the desired gain. Thus, an embodiment of 
the invention is enabled to accomplish feedforward con- 
trol in spite of changes in digging work load. 

The invention also implements an apparatus for 
controlling the end effector of a construction machine 
that employs a feedback control system for tracking 
respective positions of the end effector actuating cylin- 
ders. The apparatus includes a feedforward loop posi- 
tioned in the position-tracking feedback control system. 
Gain of the feedforward loop is adjusted in accordance 
with digging work load using a in accordance with dig- 
ging work load. In addition, according to this embodi- 
ment, a feedback gain of the position-tracking feedback 
system is adjusted in accordance with digging work 
load. Precision of position tracking with respect to dig- 
ging work load is improved by increasing or reducing 
respective gain of feedforward signals and feedback 
signals according to digging work load. By using adjust- 
ing the gain of the feedforward loop and adjusting the 
gain of the position-tracking feedback control system in 
accordance with digging work load, the invention can 
optimize both the feedforward gain and the feedback 
gain by reducing or increasing the respective gains 
according to digging work load. Therefore, according to 
the invention, precision of tracking positions of the end 
effector actuating cylinders with respect to digging work 
load is improved, even if digging work load increases 
during ground preparation work, such as horizontal lev- 
eling or slope finishing. The system also provides that, 
in cases where digging work load is small, the gains 
may be adjusted to a low level, thereby ensuring stability 
of the control system. 

The invention also implements an apparatus for 
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controlling the end effector of a construction machine 
wherein feedforward and feedback gain are adjusted 
according to pressure sensors that detect cylinder work 
load pressure of the end effector actuating cylinders. 
The invention has gain adjusting memories that store 5 
respective look-up tables. Each look-up table defines a 
relationship between a respective cylinder work load 
pressure detected by corresponding pressure sensors 
and a respective one of the feedforward gain and the 
feedback gain. According to a control procedure of the w 
apparatus the cylinder work load pressures are 
detected, the gains are retrieved from the respective 
look-up tables, and the gain of the feedforward and 
feedback signals adjusted accordingly. Thus, an appa- 
ratus according to the invention can feedforward control 75 
even with significant changes in digging work load. This 
is because, according to the above procedure, the gains 
of feedforward signals and feedback signals are 
adjusted with respect to the change of cylinder work 
load pressure detected by the pressure sensors. 20 

According to an embodiment of the present inven- 
tion, there is provided, a control method for controlling a 
piece of construction equipment that has a position- 
sensing feedback control system to track respective 
positions of an actuator that control positions of an end 25 
effector, comprising the steps of: generating a target 
value for an actual force-load acting on the actuator 
generated in response to a forcing of the end effector 
against a working material, detecting the actual force- 
load and modifying a control signal of the feedback con- 30 
trol system responsively to a result of the step of detect- 
ing and the target value. 

According to another embodiment of the present 
invention, there is provided, an apparatus for controlling 
an end effector of a construction machine that employs 35 
a feedback control system to track respective positions 
of actuating cylinders that move the end effector, com- 
prising: a pressure sensor connected to the actuator to 
communicate with a hydraulic fluid whose pressure is 
responsive to a work load affecting the end effector, a 40 
work load-setting indicator to allow a user to set a 
desired signal indicating a target work load, a work load 
control portion connected to receive the signal indicat- 
ing a target work load, the work load control portion 
being connected to the feedback control system to track 45 
respective positions such that a tracking of the feedback 
control system is responsive to the signal indicating a 
desired work load and a pressure signal of the pressure 
sensor. 

According to still another embodiment of the so 
present invention, there is provided, an apparatus for 
controlling the end effector of a construction machine 
that employs a feedback control system for tracking 
respective positions of end effector actuating cylinders, 
the apparatus including: a feedforward loop in the posi- ss 
tion-tracking feedback control system, a feedforward 
amplifier in the feedforward to adjust a gain of the feed- 
forward loop, a detector, connected to the feedforward 
amplifier, for detecting a digging work load, the gain of 



the feedforward amplifier being continuously adjustable 
responsively to the detector; and a feedback loop with a 
feedback amplifier in the feedback loop to adjust a gain 
of a feedback signal of the feedback loop, the gain of the 
feedback amplifier being continuously adjustable 
responsively to the detector. 

According to still another embodiment of the 
present invention, there is provided, a method of con- 
trolling a hydraulic construction machine having a feed- 
back position control system, comprising the steps of: 
storing an indication of a desired position constraint for 
an end effector of the construction machine, storing an 
indication of a desired speed of the end effector, moni- 
toring a working force applied to the end effector, a sig- 
nal responsive to a position of the end effector being 
applied through a feedback loop of the feedback posi- 
tion control system, amplifying the signal responsively 
to results of the step of monitoring a working force. 

The above, and other objects, features and advan- 
tages of the present invention will become apparent 
from the following description read in conjunction with 
the accompanying drawings, in which like reference 
numerals designate the same elements. 

Fig. 1 is a system block diagram of a end effector 
control apparatus for a construction machine according 
to an embodiment of the present invention. 

Fig. 2 is a block diagram of the controller of the end 
effector control apparatus shown in Fig. 1. 

Fig. 3 (A) is an explanatory drawing illustrating 
examples of loci of the tip of the bucket teeth, wherein 
the loci differ depending on the degree of priority in 
bucket teeth locus control and compaction force control 
by using said apparatus. 

Fig. 3 (B) is a graph illustrating changes in digging 
force which differ depending said degree of priority. 

Fig. 4 is a system block diagram of a end effector 
control apparatus for a construction machine according 
to another embodiment of the present invention. 

Fig. 5 is a block diagram of the controller of the end 
effector control apparatus shown in Fig. 4. 

Fig. 6 is an explanatory drawing illustrating the sys- 
tem configuration of a conventional hydraulic excavator. 

Referring to Fig. 1, a front end effector has a boom 
cylinder 14bm, a stick cylinder 14st, and a bucket cylin- 
der 14bk, which may be collectively referred to as end 
effector actuating cylinders 14. End effector actuating 
cylinders move an articulating front linkage that consists 
of a boom 15bm, a stick 15st and a bucket 15bk. 

A controller 21 controls the end effector. A stick 
operating lever 33 applies a signal indicating a target 
speed of the bucket teeth in the direction of digging. A 
slope gradient setting device 41 sets a target gradient j> 
of the finished surface slope A. A compaction force set- 
ting device 42 indicates a target compaction force. The 
priority setting device 43 establishes a balance between 
the competing priorities of constraining the geometry of 
movement (e.g.. raking the bucket teeth through a 
plane) and maintaining a constant compaction force. 
The respective target values for the two types of control 
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are set by slope gradient setting device 41 and compac- 
tion force setting device 42, respectively. 

L ; Controller 21 generates signals output to propor- 

tional control solenoid valves 35. Proportional control 
solenoid valves output pilot pressures in proportion to 
electrical signals applied by controller 21 . Control valves 
36 control pressures and volume rate of hydraulic fluid 
fed from a hydraulic source (not shown) to end effector 
actuating cylinders 14. Control valves 36 perform this 
control by regulating the positions of spools using pilot 

■ pressures generated by proportional control solenoid 

* valves 35. 

i Furthermore, position-tracking feedback loops 

18bm, 18st, 18bk, collectively referred to as feedback 
loops 18, are applied to controller 21 by angle sensors 
16bm, 16st. 16bk, respectively. Angle sensors 16bm, 
1 6st, 1 6bk detect respective rotation angles of the artic- 
ulations connecting superstructure 12, boom 15bm, 
stick 1 5st and bucket 1 5bk, respectively. The above ele- 
ments form a closed-loop control system. The angle 
sensors 16bm, 16st, 16bk may be resolvers, encoders, 
or any suitable devices. Angle sensors 16bm, 16st, 
16bk are collectively refened to as angle sensors 1 6. 

Hydraulic fluid feed and discharge lines 31 bm, 31st 
to boom cylinder 14bm and stick cylinder 14st are 
respectively provided with pressure detectors 32bm, 
32st. Pressure detectors 32bm, 32st detect work load 
pressure applied to boom cylinder 14bm and stick cylin- 
der 14st. These pressures, together with position infor- 
mation, can be used to indicate the force of contact 
between bucket 15bk and surface A. For example, a 
compaction force force generated by moving bucket 
15bk vertically is indicated through the cylinder work 
load pressure, especially of boom cylinder 14bm. 

Compaction force can be computed by multiplying 
the cylinder work load pressure of boom cylinder 14bm 
by the actual area of the inner surface of the cylinder 
receiving the pressure. The digging force can be com- 
puted by multiplying the cylinder work load pressure of 
stick cylinder 1 4st by the actual area of the inner surface 
of the cylinder receiving the pressure. 

An end effector work load feedback loop 44 for cyl- 
inder work load detected by pressure detectors 32bm, 
32st is applied by pressure detectors 32bm, 32st to con- 
troller 2 1 . Controller 2 1 has dosed-loop control compen- 
sators 52b, 52st, 52bk for controlling respective end 
effector actuating cylinders 14. Controller 21 constantly 
monitors the actual positions and speeds of boom 
15bm, stick 15st, and bucket 15bk. Controller 21 also 
indirectly monitors the working positions and speeds of 
respective end effector actuating cylinders 14 through 
signals representing the rotational angles and angular 
velocities of boom 15bm. stick 15st, and bucket 15bk. 
The latter signals are detected and fed back to controller 
21 by angle sensors 16. Controller 21 performs feed- 
back control of control valves 36, through proportional 
control solenoid valves 35, of boom 15bm, stick 15st 
and bucket 15bk in response to command signals from 
slope gradient setting device 41 and operating lever 33. 



These command signals determine the positions and 
speeds of the front linkage, respectively. 

During horizontal leveling or slope finishing, 
respective proportional control solenoid valves 35 for 
5 boom 1 5bm, stick 1 5st, and bucket 1 5bk are electrically 
controlled based on signals computed by closed-loop 
control compensators 52b, 52st, 52bk. The signals 
computed by the compensators eliminate the difference 
between the feedback signals and the target signals 
10 computed by the microcomputer. This automatically 
constrains the bucket teeth to a defined locus of points 
and keeps the bucket angle constant during horizontal 
leveling or slope finishing. Control is effected through 
proportional control solenoid valves 35, which control 
is pilot pressure to the spools of control valves 36 for cor- 
responding cylinders 14bm, 14st, and a4bk to move 
boom 15bm, the stick 15st. and bucket 15bk 

Referring to Fig. 2, each of the pressure detectors 
32bm and 32st is a differential pressure indicator com- 
20 posed of a pressure sensor 32h and a pressure sensor 
32r respectively provided at the extension-side (the 
head-side) and the contraction-side (the rod-side) of the 
corresponding cylinder. Thus, each of pressure detec- 
tors 32bm and 32st detects cylinder work load pressure, 
25 that is, the difference between the work load pressure 
detected by pressure sensor 32h at the extension-side 
and the work load pressure detected by pressure sen- 
sor 32r at the contraction-side. 

Feedback loop 44 and compaction force setting 
30 device 42 apply either respective signals to a compara- 
tor 45. The output of comparator 45 is connected to a 
computing unit 46 that computes target speed in the 
vertical direction of the tip of the bucket teeth. The verti- 
cal target speed signal generated by computing unit 46 
35 is gain-adjusted by a multiplier 47 and peak-limited by a 
limiter 48. The adjusted and limited signal is applied to 
a computing unit 51. The gain of multiplier 47 is deter- 
mined according to a signal from priority setting device 
43. Limiter 48 sets the upper and lower limits of vertical 
40 target speed of the bucket teeth that influence compac- 
tion force. Computing unit 51 has a microcomputer (not 
shown) which computes respective target positions and 
speeds of end effector actuating cylinders 14. 

Computing unit 51 applies a signal indicating com- 
45 puted target values to closed-loop control compensa- 
tors 52. Each closed-loop control compensator 52 has a 
compensating circuit that improves control characteris- 
tics, such as stability, response speed and steady-state 
deviation, so to insure that detection signals represent- 
so ing an actual position and speed of boom 15bm, stick 
1 5st or bucket 1 5st, fed back through feedback loop 18, 
precisely follow target signals for actuating the corre- 
sponding cylinder. That is, the target position and speed 
of boom 15bm. stick 15st. or bucket 15st, output from 
55 computing unit 51 performs horizontal leveling, slope 
finishing, or compaction force within controlled limits. 
Through the compensating circuits described above, 
respective closed-loop control compensators 52 output 
electrical signals, thereby proportionally controlling 
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solenoid valves 35 for boom 15bm, stick 15st or bucket 
15st using output electrical signals. 

Referring now also to Fig. 3, the embodiment 
described immediately above is operated as follows. 
First, the user sets a finished slope gradient J> for ground 
preparation of slope A by adjusting above slope gradi- 
ent setting device 41 . Then, the user moves stick oper- 
ating lever 33 to command the target speed of the 
bucket teeth in the direction of digging. This causes 
computing unit 51 to compute and output the respective 
target positions and speeds of end effector actuating 
cylinders 14. 

Meanwhile, comparator 45 compares the difference 
between the pressures which have been detected by 
pressure sensors 32h, 32 provided at the extension side 
and the contraction side of the respective end effector 
actuating cylinders 14 with the value set by compaction 
force setting device 42. The height of the bucket is then 
automatically adjusted so that each difference in pres- 
sure conforms with the target value for the correspond- 
ing cylinder. To be more specific, bucket 15bk is raised 
in order to reduce the compaction force on the ground 
surface or lowered to increase the compaction force. 

Although the tips of the bucket teeth deviate from 
the preset target locus, the deviation can be negated by 
priority setting device 43 that sets a degree of priority 
between position follow-up control and cylinder work 
load control. In other words, the priority can be set to 
favor position follow-up control strongly (or 100%) so as 
to make the actual cylinder pressures conform with the 
target pressures, and conventional bucket teeth locus 
control, i. e. cylinder position follow-up control. 

As is apparent in the example shown in Fig. 3 (A), 
giving priority to bucket teeth locus control improves the 
locus of points defined by movement of the bucket teeth. 
In other words, it improves the precision of the surface 
finish. In this case, however, digging force, represented 
by a solid line in Fig. 3 (B) may fluctuate. 

As shown in the examples represented by thick bro- 
ken lines along the line representing the target digging 
force in Fig. 3 (B), giving priority to compaction force 
control enables precision control of compaction force 
while maintaining an approximately constant digging 
force. In that case, however, the locus of points defined 
by the movement of the bucket teeth is prone to devia- 
tion from the presumed straight line target, as is appar- 
ent in the uppermost broken line in Fig. 3 (A). 

The target locus of the bucket teeth and the target 
compaction force (the target cylinder work load pres- 
sure) may be set using slope gradient setting device 41 
and compaction force setting device 42. A degree of pri- 
ority between the two control goals (compaction force 
control goal and bucket teeth locus control goal) can be 
set using priority setting device 43. With the above 
apparatus, by establishing these settings, it is possible 
to adjust the finishing precision and the hardness of the 
finished surface or a desired combination. That is, the 
user can make a choice as to which should be given 
greater importance in accordance with the demands of 



the particular operation. 

With the above apparatus, it is possible to control 
compaction force by semi-automatically raising or low- 
ering bucket 15bk according to the above-mentioned 
s degree of priority. This is because bucket 15bk, while 
moving along the surface to be finished, also applies a 
surface-normal force that compacts the surface to be 
finished. 

Referring now to Figs. 4 and 5, another embodi- 

10 ment of the invention, includes a front end effector pow- 
ered by a boom cylinder 14bm, a stick cylinder I4st and 
a bucket cylinder I4bk, collectively referred to as end 
effector actuating cylinders 14. The front end effector 
includes a front linkage that consisting of a boom 15bm, 

is a stick 1 5st, and a bucket 1 5bk. 

A position-tracking feedback control system 
includes a controller 21, which serves as the principal 
member to control the front end effector. A stick operat- 
ing lever 33 applies to controller 21 a signal indicating a 

20 target speed of the bucket teeth in the direction of dig- 
ging. Proportional control solenoid valves 35 output pilot 
pressures in proportion to electrical signals applied 
thereto by controller 21 . Control valves 36 control pres- 
sures and quantities of hydraulic fluid fed from a hydrau- 

25 lie source (not shown) to end effector actuating 
cylinders 14. Control valves 36 perform control by 
means of spools whose positions are controlled by pilot 
pressures from proportional control solenoid valves 35. 
Angle sensors 16bm, !6st, and 16bk, collectively 

30 referred to as angle sensors 16, respectively detect 
rotation angles of boom 15bm, stick 15st, and bucket 
15bk. Feedback loops 18bm, 18st, and 18bk, collec- 
tively referred to as feedback loops 18, connect respec- 
tive angle sensors 16 to controller 21 . 

35 Hydraulic fluid feed and discharge lines 31 bm, 31 st 
to boom cylinder 14bm and stick cylinder 14st are 
respectively provided with pressure detectors 32bm, 
32st. Pressure detectors 32bm, 32st detect a work load 
pressure applied to boom cylinder 14bm and stick cylin- 

40 der 14st. The work load of a digging operation (the dig- 
ging force) can be computed by multiplying the cylinder 
work load pressure by the actual area of the inner sur- 
face of the cylinder receiving the pressure. 

As the load on stick cylinder 14st during horizontal 

45 leveling or slope finishing changes substantially, pres- 
sure detector 32st for stick cylinder 14st is indispensa- 
ble. On the other hand, as load change on boom 
cylinder 14bm is minimal, pressure detector 32bm for 
boom cylinder 14bm may optionally be omitted from the 

so control system. 

A compaction force signal 71 is computed from cyl- 
inder work load detected by pressure detectors 32bm, 
32st is provided from pressure detectors 32bm, 32st 
and applied to feedback and feedforward controller 21. 

55 Lookup tables 72a and 72b (collectively, 72) adjust the 
gain feedback signal 71, producing feedback signals 
71a and 71b. Lookup tables 72 reduce or increase feed- 
back gain or feedforward gain according to cylinder 
work load pressure (the digging work load): 
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Controller 21 is provided with closed-loop control 
compensators 52bm, 52st, and 52bk, collectively 
referred to as closed-loop control compensators 52. 
Controller 21 controls respective end effector actuating 
cylinders 14 by constantly monitoring actual positions 
and speeds of boom 1 5bm, stick 1 5st, and bucket 1 5bk 
Controller 21 also indirectly monitors the working posi- 
tions and speeds of end effector actuating cylinders 14 
through signals that represent the respective rotational 
angles and angular velocities of boom 15bm ( stick 15st 
and bucket 15bk fed back to controller 21 by angle sen- 
sors 16, the positions and speeds being calculable 
based on the known geometry of the front linkage. Con- 
troller 21 performs feedback control of control valves 36, 
through proportional control solenoid valves 35, to 
cause boom 15bm, stick 15st, and bucket 15bk to follow 
command signals that determine the target positions 
and speeds of the front linkage. 

Referring again also to Fig. 3, during horizontal lev- 
eling or slope finishing, proportional control solenoid 
valves 35 for boom 15bm, stick 15st, and bucket 15bk 
are electrically controlled based on signals computed by 
closed-loop control compensators 52b, 52st, 52bk. 
Closed-loop control compensators 52b, 52st, 52bk elim- 
inate differences between the feedback signals 18 and 
the target signals computed by the microcomputer to 
actuate the respective cylinders. To automatically con- 
strain the locus of points defined by movement of the 
bucket teeth (for example, to a plane), and maintain the 
bucket angle constant, during horizontal leveling or 
slope finishing, solenoid valves 35 proportionally control 
valves 36 for the boom, the stick, and the bucket so that 
respective pressures of hydraulic fluid output by control 
valves 36 extend or contract end effector actuating cyl- 
inders 14. Stick operating lever 33 and slope gradient 
setting device 41 , used to set a target gradient J> of a fin- 
ished slope A in ground preparation work, are con- 
nected to a computing unit 61. Computing unit 61 
computes target speeds of respective end effector actu- 
ating cylinders 14. After the slope gradient setting 
device 41 sets finished slope gradient j> for forming 
slope A, the user simply moves stick operating lever 33 
to instruct the system as to the desired target speed of 
the bucket teeth in the direction of digging. Computing 
unit 61 then computes and outputs the respective target 
positions and speeds of the end effector actuating cylin- 
ders 14. 

. An integrator 62 integrates the target positions and 
speeds output by computing unit 61 generating signals 
proportional to respective target positions of the boom, 
the stick and the bucket. The target position output line 
of integrator 62 and feedback loops 18 from respective 
angle sensors 16 are applied to inputs of a comparator 
64. An output of comparator 64is applied to a closed- 
loop control compensators 52. A multiplier gain-controls 
the output of comparator 64 responsively to feedback 
signal 71a. 

Each closed-loop control compensator 52 has a 
compensating circuit for improving control characteris- 
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tics of the feedback control system, such as stability, 
response speed and steady-state deviation. Control 
compensator 52 generates an output that controls the 
actuating cylinders so that the signaJ representing 

5 actual position of the boom, the stick, or the bucket pre- 
cisely conforms with the target signal for actuating the 
corresponding cylinder, i. e. the target position of the 
boom, the stick or the bucket 

The solenoids and other suitable members of pro- 

10 portional control solenoid valves 35 are connected 
through an adder 67, an amplifier (not shown) and other 
necessary devices to closed-loop control compensators 
52 described above. The output signal of computing unit 
61, indicating target speed, is gain-controlled by a mul- 

15 tiplier 68, and applied to an adder 67 forming a feedfor- 
ward loop 69. The gain of multiplier 68 is controlled by 
feedback signal 71b. 

Each of pressure detectors 32bm and 32st is a dif- 
ferential pressure indicator composed of a pressure 

20 sensor 32h and a pressure sensor 32r respectively pro- 
vided at the extension-side (the head-side) and the con- 
traction-side (the rod-side) of the corresponding 
cylinder. Thus, each of pressure detectors 32bm and 
32st detects cylinder work load pressure, that is, the drf- 

25 ference between the work load pressure detected by 
pressure sensor 32h at the extension-side and the work 
load pressure detected by pressure sensor 32r at the 
contraction-side. 

Signal line 71, which conveys signals representing 

30 cylinder work load detected by pressure sensors 32h 
and 32r, branches into a feedback gain adjusting signal 
line 71a and a feedforward gain adjusting signal line 
71b. Lookup table 72a is used to adjust the gain of the 
feedback signal. Lookup table 72b is used to adjust the 

35 gain of the feedforward signal. The signal indicating 
gain are applied to multipliers 65 and 68 by lines 71a 
and 7b, respectively. 

While pressure sensors 32h and 32r, and lookup 
table 72a, constitute a feedback gain-adjusting device 

40 used to adjust the gain of the position-tracking feedback 
control system, pressure sensors 32h and 32r and 
lookup table 72b constitute a feedback gain adjusting 
device used to adjust the gain of feedforward loop 69. 
Both adjustments are made according to digging work 

45 load. 

Lookup tables 72a, 72b store in their memories pre- 
determined relationships between work load of cylin- 
ders including stick cylinder 1 4st and respective gains of 
feedback signals and feedforward signals to automati- 

so cally adjust the gains by reducing or increasing them 
according to cylinder work load (digging force) detected 
by pressure sensors 32h, 32r. The portion of feedback 
gain adjusting signal line 71a passing through lookup 
table 72a is connected to multiplier 65, while the portion 

55 of feedforward gain adjusting signal line 71b passing 
through lookup table 72b is connected to multiplier 68. 

With the configuration described as above, where 
gains of feedback signals and feedforward signals are 
automatically reduced or increased by lookup tables 
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72a, 72b according to fluctuation in cylinder work load 
obtained by pressure sensors 32h, 32r, the invention is 
capable of improving the precision in position tracking of 
stick cylinder 14st with respect to such disturbance as 
digging work load. By increasing the gain, the above 5 
configuration makes effective use of the integral com- 
pensation added to closed-loop control compensators 
52 to reduce deviation of actual positions of stick 15st 
and the like from their target positions. This improves 
the finishing precision in horizontal leveling or slope fin- 
ishing, shown in the drawings. 

While semi-automatically performing slope forma- 
tion, for example, should the digging load be judged to 
have increased by increase of the pressure at the exten- 
sion-side (the head-side) of stick cylinder 14st, gains of 
feedback signals and feedforward signals are automati- 
cally increased by respective lookup tables 72a, 72b. A 
large digging work load corresponds to abundant load 
material (earth/sand) around bucket 15bk, which result- 
ing in heavier attenuation of movement of the front link- 
age. Because of the attenuation, the control system is 
disinclined toward instability even as the gains of feed- 
back signals and feedforward signals are increased. 
Where the digging work load is small, lookup tables 
72a, 72b automatically reduce the gains of feedback 
signals and feedforward signals, thereby insuring stable 
control. 

Note that although according to the embodiments 
described, loads on the end effector are sensed by 
measuring hydraulic pressure, any of a number of alter- 
natives would occur to a person of ordinary skill based 
on the above disclosure. For example, strain gauges, 
solid-state and electro-mechanical force-sensors could 
be applied to the invention to achieve the same benefits 
discussed above. At least some of the claims appearing 
below are intended to embrace such alternatives. 

Note also that although the present application dis- 
cusses the invention in connection with the control of a 
back hoe, it is clear from the disclosure that the inven- 
tion is applicable other kinds of equipment. For exam- 
ple, scrapers, raking machines, cranes. In fact, the 
invention need not be applied for surface finishing 
because any kind of position-tracking equipment could 
be made to operate in a more coordinated manner by 
augmenting the control system using load detection as 
described. Such variations are considered to fall within 
the scope of at least some of the claims. 

Note also that although the invention has been 
described in connection with hydraulic equipment, it is 
applicable to equipment that uses other types of actua- 
tors. At least some of the claims are drafted to embrace 
such alternatives. 

Although only a single or few exemplary embodi- 
ments of this invention have been described in detail 
above, those skilled in the art will readily appreciate that 
many modifications are possible in the exemplary 
embodiment(s) without materially departing from the 
novel teachings and advantages of this invention. 
Accordingly, all such modifications are intended to be 



included within the scope of this invention as defined in 
the following claims. In the claims, means-plus-function 
clauses are intended to cover the structures described 
herein as performing the recited function and not only 
structural equivalents but also equivalent structures. 
Thus although a nail and screw may not be structural 
equivalents in that a nail relies entirely on friction 
between a wooden part and a cylindrical surface 
whereas a screw's helical surface positively engages 
the wooden part, in the environment of fastening 
wooden parts, a nail and a screw may be equivalent 
structures. 

Claims 

1. A method for controlling a construction machine 
having a position-sensing feedback control system 
to track positions of an actuator (14) that controls 
positions of an end effector (15), characterised by 
the steps of: 

generating a target value for an actual force- 
load acting on said actuator (14) generated in 
response to a forcing of said end effector (15) 
against a working material; 
detecting said actual force-load; and 
modifying a control signal of said feedback con- 
trol system in response to the actual force-load 
and said target value. 

2. A method as in claim 1 , wherein said step of detect- 
ing includes detecting a pressure of an hydraulic 
fluid of said actuator (1 5). 

3. A method as in claim 2, wherein said step of detect- 
ing includes detecting a differential pressure of the 
hydraulic fluid acting on extension and retraction 
sides of a linear actuator (14). 

4. A method as in claim 3, wherein said step of detect- 
ing includes detecting a differential pressure of 
hydraulic fluid acting on extension and reaction 
sides of a hydraulic linear actuator (14). 

5. A method as in claim 1 , wherein said step of modi- 
fying includes establishing a target speed of a com- 
ponent of movement of said end effector (15), said 
component being chosen to affect said actual force- 
load. 

6. A method as in claim 1, further comprising the 
steps of: 

establishing a priority between a position-track- 
ing control-goal of said position-sensing feed- 
back control system and said target-value of 
said force-load; 

generating at least one of a target speed of 
said actuator (15) and a target position of said 
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actuator (15) in response to establishing prior- 
ity. 

7. A method as in claim 6, wherein: 

5 

said target force-load is proportional to a soil 
compaction force applied by said machine; 
said step of generating at least one of a target 
speed of said actuator (14) and a target posi- 
tion of said actuator (14) includes determining w 
a position of said end effector (1 5) in a direction 
normal to a surface worked by said machine. 

8. A method as in claim 1 , wherein: 

15 



an amplifier (68) is connected to amplify a sig- 
nal in said feedforward loop (71b); 
the gain of said amplifier responding to a work 
load applied to said end effector (15). 

12. An apparatus as in claim 1 1 , comprising: 

a force-sensor (32) connected to said actuator 
(14) to detect said work load; 
an output of said force sensor (32) connected 
to a gain-adjusting input of said amplifier (68), 
whereby said gain is adjusted in response to an 
output of said force-sensor (32). 

13. An apparatus as in claim 12, wherein: 



said target force-load is proportional to a soil 
compaction force performed by said piece of 
construction equipment; 
said step of generating includes determining a 
position of said end effector in a direction nor- 
mal to a surface worked by said machine. 

9. An apparatus for controlling an end effector (15) of 
a construction machine that employs a feedback 
control system to track respective positions of actu- 
ating cylinders (14) that move said end effector 
(15), characterised in that: 

a pressure sensor (32) is connected to said 
actuator (14) to sense a pressure in an hydrau- 
lic fluid in response to a work load affecting 
said end effector (15); 

a work load-setting indicator (42) allows a user 
to set a desired signal indicating a target work 
load; 

a work load control portion (45) is connected to 
receive said signal indicating a target work 
load, said work load control portion (45) being 
connected to said feedback control system to 
track respective positions such that a tracking 
of said feedback control system is responsive 
to said signal indicating a desired work load 
and a pressure signal of said pressure sensor. 

10. An apparatus as in claim 9, comprising: 

a user-actuated priority indicating device (43) 
including; 

means for altering a sensitivity of a response of 
said feedback control system to track respec- 
tive positions to said work load control portion. 

11. An apparatus for controlling an end effector (15) of 
a construction machine that employs a feedback 
control system for tracking the position of end effec- 
tor actuators (14), characterised in that: 

a feedforward loop (71b) is provided in said 
position-tracking feedback control system; and 



said actuator (1 4) comprises an hydraulic cylin- 
der, and 

said force-sensor (32) comprises a pressure 
detector connected to said hydraulic cylinder 
(14) and in communication with a hydraulic fluid 
of said hydraulic cylinder (14). 

14. An apparatus as in claim 12, comprising: 

a memory; and 

a signal filter connected between said force- 
sensor and said gain-adjusting input, said sig- 
nal filter applying, to said gain-adjusting input, 
a signal responsive to said force-sensor and 
said memory. 

15. An apparatus for controlling an end effector (15) of 
a construction machine that employs a feedback 
control system for tracking respective positions of 
the end effector (15) actuating cylinders (14), char- 
acterised in that said apparatus includes: 

a feedforward loop (71b) in said position-track- 
ing feedback control system; 
a feedforward amplifier (68) in said feedforward 
loop (71b) to adjust a gain of said feedforward 
loop (71b); 

a detector (32), connected to said feedforward 
amplifier (68), for detecting a digging work 
load; 

said gain of said feedforward amplifier (68) 
being continuously adjustable in response to 
said detector (32); and 

a feedback loop (71 a) with a feedback amplifier 
(65) in said feedback loop (71 a) to adjust a gain 
of a feedback signal of said feedback loop; 
said gain of said feedback amplifier being con- 
tinuously adjustable in response to said detec- 
tor (32). 

16. An apparatus as in claim 15, wherein: 

said actuating cylinder is an hydraulic cylinder 
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(14); 

said detector (32) includes a pressure sensor 
in communication with a hydraulic fluid of said 
hydraulic cylinder (14); 

said feedforward amplifier (68) is connected to s 
said detector (32) through first a filter (72b) that 
controls said gain of said feedforward amplifier 
in response to said detector (32) and data 
stored in a memory, said data indicating a rela- 
tionship between a desired gain of said feedfor- io 
ward amplifier (68) and the digging work load. 

17. An apparatus as in claim 16, wherein said feedback 
amplifier (65) is connected to said detector (32) 
through a second filter (72a) that controls said gain 15 
of said feedback amplifier (65) in response to said 
detector (32) and data stored in a memory, said 
data indicating a relationship between a desired 
gain of said feedback amplifier (65) and digging 
work load. 20 

18. An apparatus as in claim 1 5, wherein said feedback 
amplifier (65) is connected to said detector (32) 
through a second filter that controls said gain of 
said feedforward amplifier in response to said 25 
detector (32) and data stored in a memory, said 
data indicating a relationship between a desired 
gain of said feedback amplifier (65) and digging 
work load. 

30 

19. A method of controlling a hydraulic construction 
machine having a feedback position control system, 
characterised by the steps of: 

storing an indication of a desired position con- 35 
straint for an end effector (15) of said construc- 
tion machine; 

storing an indication of a desired speed of said 
end effector; 

sensing a working force applied to said end 40 
effector; 

applying a signal responsive to a position of 
said end effector through a feedback loop of 
said feedback position control system; 
amplifying said signal in response to said work- 45 
ing force. 

20. A method as in claim 19, further comprising the 
step of amplifying a feedforward signal, in response 

to at least one of a stored desired speed and a so 
stored desired position constraint, in response to 
said working force. 

21. A method as in claim 20. wherein said step of 
amplifying includes adjusting a gain in response to 55 
function stored in a memory. 
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